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I. INTRODUCTION 


A. AN/TPQ-27 INTRODUCTION 

The AN/TPQ-27 system is a tactical aircraft guidance and 
control system used by the Marine Corps to guide strike force 
aircraft along a preplanned route, and then down a final leg 
for the purpose of performing precision bombing. 

The mission control and guidance is divided into two 
modes. The first mode, called Coarse Guidance, takes the 
aircraft from a TACAN entry point through a series of 
Straight paths and command turns. These "legs" of the Coarse 
Guidance run are defined by the leg end points. The actual 
route to be followed is determined by tactical considerations. 
The last leg is also the bombing leg. After proper entrance 
onto the final approach to the bombing leg, the second mode 
of the mission guidance control takes command; this is called 
Preeision Guidance. Durine the Precision Guidance mode, very 
accurate aircraft position estimates aie developed to enable 
bomb placement calculations which will be accurate to errors 
mache order of feet_at the final impact point. The primary 
difference between AHeee two modes, other than purpose, is 
the radar precision used to make the measurement of aircraft 
position. The resultant precision is also a function of the 
data rates of the respective radars, which differ signifi- 
cantly in this case. 

fiipes initial efforts of this system have suffered from 


some problems which are also apparent from observation of the 





results of software simulations of actual missions. The 
purpose of this study was to look into various techniques 
currently employed in the simulation programs, and attempt 
to improve the response and overall accuracy of the system 


through the use of different and/or improved algorithms. 


B. AN/TPQ-27 PROBLEM AREA DEFINITION 

The specific problem areas which were investigated were 
defined primarily through contact with personnel closely as- 
sociated with the system's performance. Other areas were 
noted as in need of improvement during the familiarization 
-and simulation trial phases of study. 

ia LOoOlenenrease in Coarse GUuidanee 

Coarse guidance has suffered from many separate but 

related problems. Pilots have complained that the controls 
Sent to the aircraft in the final moments before turning to 
a new leg have been violent. In addition, there have been 
complaints of not knowing where the aircraft was at any time 
Other than having just exited from a "command turn," 1.e., 
aeturn from one leg onto a new leg, vice a course correction. 
The simulation program was found to be suffering from unneces- 
sary complexity in some areas, and was apparently in need of 
Sreitined estimation and control procedures. | 

en nO enn eas eines LeCiston Guidance 

The single most prevalent complaint with the Precision 

Guidancé program was the length of time required for thé es- 
Moimates to stabilize in order than an eccurate determination 


Simmexactiy wirén the bomb should be dropped cotld be made. 





Again, this and other related problems with Precision Guid- 
ance seemed due to inadequate aircraft estimation algorithms, 


and a control scheme which was too simplistic in design. 
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II. AIRCRAFT POSITION AND VELOCITY ESTIMATION 


A. BACKGROUND AND INTRODUCTION TO THE KALMAN FILTER 

The technique previously used to provide noise filtering 
on aircraft position and ONCE: was a standard alpha-beta 
filter with parameters chosen to yield the "optimal" track- 
ing capability in accordance with the theory developed in 
[i]. However, this reference also states that in the case 
when adaptive tracking is required, the a parameter should 
be permitted to vary with observed high frequency power 


fluctuations in the error signal 


where xX 1s the state estimation, ana Aon TS tame sseacce tee 
diction prior to measurement. Provisions for this variation 
were not included in the tracking algorithm which was imple- 
mented. In addition, the alpha-beta filter which was imple- 
mented was not an unbiased estimator of the aircraft state 
meecton. | [his 15 due €6 €he fact that as controls were used 
momecdulse Changes in the free inertial model of the motion 
assumed by the alpha-beta filter, no corresponding changes 
mere added to the filter states to account for this determin- 
mstically added control. This accounts for the exceptionally 
‘large and prolonged transient errors which resulted from 
large control bank commands. 

The Kalman filter yields a minimum variance estimate of 


mine State vector when the statistics of the notse are as 


ie 





described below. This filter includes the effects of deter- 
ministic control commands to the aircraft to viata an esti- 
mator which is very nearly unbiased. The greatest improvement 
in estimation is yielded during the initial filter transient 
behavior. This is particularly critical in this application, 
in order to overcome the long filter settling period required 


Dy the alpha-beta filter. 


B. KALMAN FILTER ASSUMPTIONS AND GENERAL RECURSION EQUATIONS 
Application of the Kalman filter assumes that the discrete 


System under consideration satisfies 


{l 


X(k+1) = o(k)X(k) + Wk) (2) 


Z(k) = H(k)X(k) + V(k) (3) 


where X 1S an n X 1 state vector, Zi1s an m xX 1 output vector, 
Wis a zero-mean n x 1 vector of state excitation white noise, 
uncorrelated with the zero-mean additive white noise vector V\V, 
® 1s the state transition matrix (n x n), and H is the mxn 
observation or measurement matrix. The assumed noise sta- 


mistics are 


B[V(k) V(j)"] = RK) 6(k, 3) (4) 
E(P(WCK) WG)TITT = QC) 6(KI) (5) 
E{V(k) W(j)4] = 0 for all k,j (6) 
where 
é(k,j) = { ° KP (7) 
| 1 k=j. 


The actual Kalman filter recursion equations are summarized 


Wee 





below, where X(k/j) denotes the estimate of the state X(k) 


bascdelpon the 7 measurement observations Z(1),Z(Z),...,Z(j). 


P(k/k-1) = $(k,k-1)P(k-1/k-1)6(k,k-1)! + Q(k) (8) 
G(k) = P(k/k-1)H(k) [H(k)P(k/k-1)H(k)" + R(K)] 7? (9) 
P(k/k) = P(k/k-1) - G(k)H(k)P(k/k-1) (10) 
ae Oy ee 2 (eC) Xe ke 1) ca) 
X(k/k-1) = 6(k,k-1)X(k-1/k-1) + P(k)U(k-1) (12) 


where P(k/k-1) is the covariance of error for the state pre- 
fiction vector X{k/k-1), P(k/k) is the covariance of error 
matrix for the state estimation vector X(k/k), and G(k) is 


eieegail Matrix ta be applied at the time of the , th measure- 


iemitemerixther detall on the Suiliary ana aevelopment of the 
Kalman filter equations is available in [2], [3], and [4]. 


oe SELECTION OF REQUIRED SYSTEM MODEL ORDER 
HitcmonuecrOrmNeleeiilucr = rerers to 1tSecapability to track 
meeaulvet Exhibiting a particular type of motion without error, 
fea noiseless environment. For a single dimensional probien, 
merirst order filter would estimate position only. second 
mracr {filters are Sarde Cech AchiiMe saGonstant velocity 
target and estimating both position and vellocity;’ Similarly, 
_ third Cider mbereLse inescapable ot Cracking a target exhibit- 
ing a constant acceleration profile, estimating position, 
tPelociry and acceleration in the process. | 
Documentation provided on the original AN/TPQ-27 programs 


mietreatcd «hat the aircratt would be flying a constant airspeed 


Sy 





ProOtilermihis then indicates that the aircraft model might 
be appropriately chosen to be a free inertial (1/s*) plant. 
Command orders to the aircraft in the form of bank angles 
serve to change the cpligetactiiize headin ine adatotall ly. deter — 
ministic manner, provided the true transfer function of the 
aircraft is known with respect to roll response. In view of 
the above, it was originally thought that it would be suffi- 
Event to implement second order Kalman filters to estimate 
Mosition and velocity in each of the three coordinates, 

Pele tding a sixth order filter. 

It was later discovered that a problem known as auto- 
pilot bank angles bias exists with sufficient frequency and 
mesuiltant imprecision that the order of the original feed- 
back loop was increased to compensate for the error through 
fre use of a discrete integrator [5]. Concepts such as in- 
tegrators and digitally implemented lead-lag networks were 
to be avoided in the improved version of the simulation 
routines due to the resultant phase lags which they introduce. 
Pies 1S not to say that the steady-state response iS in error, 
mitesimply that the time to reach that state 1s unsatisfac- 
merily long. When simulations Were Tulum With non-zero auto- 
pilot bias bank angles in conjunction with second order kalman 
Pra lters, significant errors resulted. 

Pei mane vencaloese tie dircrart to turn in a given direc- 
@ron at a constant heading rate. It was postulated that it 
Maght be possible to estimate the bias angle, and induce an 
mata -bias in the estimator, but the noise on the bias cstimate 


proved to be excessive. 
14 





Pindeonder tiulters will estimate a constant acceleration. 
The second attempt to overcome the bias problem was to postu- 
late that the acceleration in the horizontal components would 
not change significantly over the relatively short periods of 
flight time in question. (Of course, if a bias existed and 
the aircraft was flown for a long enough time, the path flown 
would appear as a circle, and the third order filters could 
not possibly be satisfactory for that situation.) Thus, de- 
velopment of two separate filtering schemes was pursued. A 
sixth order (second order for each of three dimensions of 
Maeten) and a Ninth order {third order for cach of the three 
damensions) filter were developed and tested. Use of the 
programs is very similar for each of the filters and is 
described below. 

D. DERIVATION OF THE COVARIANCE OF MEASUREMENT NOISE MATRIX, 

R(k) 

The Kalman Filter assumptions include linear relationships 
among measurements and states, as well as linear state tran- 
feeron dynamics. The £1rst of these 1s of concern at this 
weenie, Ihe states of Concern im measurement have been se- 
lected as Cartesian eeandi nace s aoe dONwcVer, tie radar 
measures range, azimuth, and elevation. The assumed relation- 

Ship between the states and the measured values are as shown 


an Fig. 1 and given by the equations below. 


R cos8 sin# (13) 


xX = 
y = R cosé cos (14) 
Z = R sane (15) 


> 








Zz 
O 
Yo y 
NORTH 
x | 
O 
EAST 
SF 
x 
= kerCOSUMm Sing 
O O O O 
A RG cosé. COS®, 
z = R_ siné@ 
O me O 
Figure 1. Illustration of assumed coordinate System used in 


ine radar ssrlters. 
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where Ris the range to the aircraft, 8 is the elevation 
angle, and ¢ is the azimuth angle of the aircraft from 
North. 

Note that this form departs from that as given in (3) 
since the relationship between the measured variables and 
the states is a nonlinear one. If the states were directly 


observable, then (3) would appear as 


z1(k) v1(k) 
22(k) = H(k) X(k) + [v2(k) (16) 
z3(k) v3(k) 


where for a sixth order system 


E 07 0 0.0 o | 


H(k) = {0 0 1 0 0 0 (ry) 
(oO ee ee eG 
and 
X(k) = [x(k) x(k) y(k) ¥(k) 2(k) 2001", (18) 


Similarly, for a ninth order system 


il 


X(k) = [0 0 0 1 00 0 0 0 (19) 
Ome OOO en C/O m0 
and (20) 
Ree iecdieec() clk yey (k) yk) z(k) 2(k) 2(4)} 


Thus, in both cases the equations reduce to 


21(k) x(k) v1(k) | 
z2(k)} = fytk)| + | v2ck) (21) 
25K) Z 11S) v3(k) 


Ly 





th 


where vl(k) is the k component of noise added to the x co- 


th component of noise added to the 


ordinate, v2(k) is the k 
mecoordinate, and v3(k)}) is the th component of noise added 
to the z coordinate. Due to the linearity of this problen, 
the three coordinate components might be considered as being 
statistically independent, in which case the R(k) matrix 
would probably be a diagonal array consisting of the indi- 
vidual coordinate measurement variances which would be con- 


stant for all k. For the nonlinear radar problem, the 


relationships for each k are 


zi = (R + iy) cos(6@ + Ng ) sin(¢ + ny) (22) 
=x 
Z25=V (Rot n) cos(6 + No ) cos(o + ly) oon 
= y + v2 
z35 = (R + n,.) Simo e Ng) (24) 
= zt v3 
where Ni» Ng,» and Ng are incremental noise disturbances to the 


feme range, elevation and azimuth, respectively. Expanding 


(22) yields 


-_ 


Ze Re n_.) [cosé cosng - sind Sinn] . (25) 
[sing cosny + COs® Sinn, ]. 


mit is assumed that Np and ny, are small angle perturbations, 


and therefore that 


tt 
jet 


(26) 
{ 27an) 


il « 


cos n 
9 d 


Sena a = it 


COs. vik 
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sin Ng = ng (27b) 


(can then be written as 


z1 = (R + n,.) [cos® sing - Ng sin@ sind (28) 
+ Ny cos@ cosé - Np n 4 sind cos] 
= R cos@ sind + vl (29) 
where 
vi =-Rn, sin8® sind + Rn, cos8 cosd¢d - Rn, Ny sin8 cos¢ 
+ ne cos8 sind - n, Ng sin@® sind + Ne Ny cos@ coséd 
"nL Ny ng sin® cosd¢. (30) 


Similar developments for the zl and zZ meaSurements yields 


v2 = -Rn, sin@ cos¢d - Rn, cos@ sind + Rn, n, Sind sind 


0 d 6 6 
fen 8eGOso COsd = nom.) Sind cos® - n. n -OS8 sing 
r ? Cod : i age = i 


sae eet gua sin@® sind (31) 


a 


@ 


and 


v3 Rn, cos@ + i sin®@ + nn sind. (32) 


8 8 
Repeating (4), the equation for the covariance of measurement 


error matrix 15 
v (hk) 
R(k) = E v2 (k) hovale (ho leeee (i) © Vo) | ; (35) 
| v3(k) 
im 15 assumed that nis much Smaller thank. ~ Evaluating the 


diagonal terms of R(k) yields 


Ged). = R* oF Smicies 1c omdR-o +. COS OL cos  ¢ 


“ (34) 


2 R70 504 sin*@ cos*¢ + O. E05 © Sino 


i 





Rie ee R’op Simo cos o + Rog Coser sin © 


(35) 
+ Ro go 4 sin?@ sin*¢ + oe cos*@ cos7@ 
Gp op Raeencos-@ 4c" sin’. (36) 


The off-diagonal elements are simply the expected values of 


the cross product terms, and are computed in the same way 


yielding 
R(1,2) = R?o2(1 - 04) (sin?6 sing cos) 
(37) 
+ (oF - R°o4) (cos *6 Sind cos) 
R(2,3) = (0? - R?a%)(sin® cos@ cosé) (38) 
R(1,3) = (or 7 Ro) (sine cos@ sind). (39) 


mae to tne symmetry of the R(k) array, it 1s also truc that 


R(2,1) = R(1,2) (40) 
R(3,1) = R(1,3) and (41) 
reo ye) = R255). (42) 


meee that the R(k) matrix is in fact not a constant array, 
but is one which is state dependent, or rather R, 8, and 9 


dependent. 


- 


E. STATE PREDICTION EQUATIONS 

The state prediction equations are used to predict ncaa 
from the current estimate to some arbitrary future point in 
mene. Normally this time 1s that of the next measurement, 
however, this is not wiiavscetiesease.. AS a relevant example, 
mmcodrsé Guidance, it is required to predict ahead several 


eames between radar samples, due to the long sampling interval 


2.0 





of the radar, and the need to precisely determine times to 
order command turns. 
ieeotatce eredicetion jn the Linear Case 
The analysis which follows will be addressed primarily 
to the ninth order case. The state vector is given in (20). 


The strictly linear prediction equations are given by (12) 


where 
iWee 1 f tee [oo 0 
ia cen Omen | OU O a0 
0 0 Oa 0 | On 205 0 
aoe Cele cr - l 9 0 0 
mik.k-1)= |0 0 0 !o01 7 | o 0 %6 (43) 
0 0 0 lo o 1 | 9 8 
Coenen | 0 0 0 | itil 
| | ° 
i oO) OMeC peer 
0 0 0 | ce omero 001 ; 
a6 0 0 
T2/2 0 0 
Tae 0 0 
0 | eG 0 
'(k) = 0 a2 0 (44) 
0 T 0 
0 0 T?/6 
0 0 T2/2 
| 0 0 a 
=! 
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and | 
U(k) = [a (k) ay(k) alc)", (45) 


Note that although in general the $? and Tl matrices are func- 
Guens of kK, in this case they are not. This is an arbitrary 
choice. Normally, T represents the interval between sampling 
points and is a constant. If one wished to predict ahead by 
ZT, he could either perform the prediction operation twice 

in succession, or simply compute a new > and If matrix using 
mein place of J. The former technique 1s used in this study. 

The U(k) array represents the deterministic forcing 
for each of the three dimensions; the units are distance per 
sec*® since the forcing is an acceleration rate. (For the 
pmecth order filter U(k) is an acceleration (distance/sec’).) 
This must be a function of k since at each time point the 
Bomcrol to the aircraft may be Tironenth and in general will 
mem. ferent . 

The above linear prediction equations of motion are 
those which would normally be used in a Kajman Filter.) ilow- 
reer, lt was found that these equations did not yield results 
Mieesuiticient accuracy, A nonlinear technique was required 
to obtain precise Pecuece This is derived below, along with 
mae e€quations for aircraft response to a bank angle command. 

ee Alneraltt Response eto Bank Commands 

The aircraft is sent bank angle commands in order to 
cause heading changes. The flight profile is assumed to be 
m coordinated turn, in which there is no motion in the verti- 


me plane, and the heading rate change 1S proportional to the 


ZZ 





bemk angele, as described in [6].. The relationship is 


Vie > ao} 


where i is the heading rate in degrees/sec, g is the earth's 
gravitational constant (32.2 ft/sec*), V is the airspeed in 
ft/sec, and 6, is the actual angle of bank. 

The roll transfer function of the aircraft can be 


approximated by 





See 1/(st, + 1) (47) 


4 
as given in [6], where T) is the response time constant. T) 


is a function of the particular aircraft in use. The dis- 
cretized version of the solution to the differential equation 
resulting from (47) is 


-T/Tt -T/T 


(kK) = @Ck-1)-e 9°) + otk-De 


(48) 


where T is the interval between predictions, oo TS eae 7c OM 
manded bank angle, and $(k) is the actual bank angle at time 


in). Then the turning rate is 
W(k) = (g/V) @(k). (49) 


To get the incremental heading angle change over the time T, 


mumtegrate (49). 





sli ok 
AW(k) = | ) dt = ce/v) [ o(k) dt (50) 
"0 : -t it 
Ty 
= (g/V) fo. Cx)t + (o(k-1) - o.09)) 4 
: “i 
= 





(50) 


“T/T, 
(g/V) [6,(K)T + (O(k-1) - o. 00), )G - e 


)]. 


Then 


v(k) = v(k-1) + Ap(k). (51) 


bee otaeeerreaiction in-the Nonlinear Case 
A ninth order filter is assumed for this analysis. 
The analysis includes effects of wind motion in x and y, and 
assumes knowledge of the wind components. Since the filter 
meeuies a2 Constant acceleration track, the acceleration pre- 


diction equations are 


x (k-1/k-1) (52a) 


X(k/k-1) = 
Al ioe ay cad / ea) (52b) 
z(k/k-1) = Z(k-1/k-1). (52c) 


Since the new heading is known in terms of the command bank 


angie, the predicted velocities are 


X(k/k-1) = V(k-1)sin[w(k)] + W, + €(k-1/k-1)T (53a) 
gd iene eo iui ane Ww, + Seay lena) (SS 
5 (k/k-1) = 3(k-1/k-1)T (53c) 


where V(k-1) 1s the estimated air speed at time T(k-1), and 
W.. and Wy are the estimated wind components. The predicted 
mesition 1S approximated through the use of numerical integra- 
tion using the Euler-Maclaurin summation formula, retaining 
“only ict ~eCOgue ecto reli IM, Ooeneral., this tormula is 
Siven by [7] as 

| Hegel kG f. a fie. i fi) aay: Cl - A ee 


t 
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The equations involving the integrals are 

; (k) 

x(k-1/k-1) + amet (55a) 
RT) 


pay ea) 


. T(k) 
y (k-1/k-1) + of y(t) dt (55b) 


y (k/k-1) 


PA ieee mE aly eerie z(t) dt. (55c) 


i 


Applying (54) yields 


A 


sc(fie/fleat = x {k-1/k-1) “ * ix (k-1/k-1) + x(k/k-1)] 
T2 ,2 n (56a) 
- ty [%, (k/k-1) - & (k-1/k-1)] 
y(k/k-1) 2 y(k-1/k-1) + £ [¥(k-1/k-1) + ¥(k/k-1)1 
T2 (4 n (S6b) 
- TG ck/k-1) - §, Oe-1/k-1)1 
Pale as ee Teele) } (56¢) 


where Xx, and ve represent total accelerations in x and y. The 
Simplification of the equation used to predict altitude is a 
mesult of the fact that there is no deterministic forcing in 
fhat direction. 

A discussion On the relationship between the accelera- 
tion estimate ¥(k/k-1) and the total accelerations shown in 
Msoe@) and (S56b)§is required at this point. The purpose of 


Metimating an acceleration is due to the fact that bias bank 


emeles exist which tend to cause 4 Continuous turning motion, 


Za 





and thus. additional and unknown accelerations in the x and y 
directions. The prediction method as described above will 
puace the alrcraft at exactly the correct point with the 
correct velocity if there is no bias. In this case, the es- 
timator will estimate that zero additional acceleration is 
present. In the case in which an unknown pee bank angle is 
present, the prediction equations will not be moving the air- 
craft heading angle the correct number of degrees/sec and 
thus lag will develop in the filter. This lag will cause a 
non-zero acceleration to be estimated, and this value will 
subsequently be added appropriately to the respective vel- 
Geity components in order to compensate for the insufficient 
motion. 

In summary, the acceleration estimate is not an esti- 
mate of the total acceleration, but is only an estimate of 
that acceleration which is unknown, due possibly to a variety 
of causes, but due primarily to an unknown bias angle in the 
autopilot roll reference. Thus the derivatives with respect 
fortime of the velocity components in (56a) and (56b) do not 
equate to the acceleration estimates. Rather, they may be 
computed by differentiating equations (53) with respect to 
time and assuming that X(k-1/k-1) 1s approximately constant. 


This yields 


%(k/k-1) = VOk-1) cos [¥(K) 160K) (57a) 


-V(k-1) sin{¥(k)])(k) (57b) 


¥ 4 (K/K-1) 


and 
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SX (k-1/k-1) = V(k-1) cos[(k-1)] ¥(k-1) (58a) 


il 


§,(k-1/k-1) = -V(k-1) sin[w(k-1)] ¥(k-1). (58b) 


F, KALMAN FILTER IMPLEMENTATION 

Two separate Kalman filter subroutines were developed to 
Pentitace the operation and filtering of the radar processor. 
RADAR6 is the sixth order filter and RADARS is the ninth order 
filter. Their implementation in software is very similar; the 
differences are described below along with specific character- 
istics of the Kalman filter which apply to both versions. A 
Pemeral flow diagram for the filter is presented as Fig. 2. 

1. Differences in RADAR6 and RADARS 

The obvious difference between the two filters is 
that one is capable of tracking a maneuvering aircraft with 
nonzero autopilot bank angle bias, and the other is not. This 
is due to the fact that the sixth order filter does not include 
ine acceleration states in xX, y, and z. The price paid for 
this additional estimation capability is an increase in com- 
putation time and program size. As implemented, the ninth 
seacr filter requires about 32 percent more storage alloca- 
tion in memory than does RADAR6; RADARG requires about 76 k 
Bytes of storage on an IBM 360-67. The incréased computation- 
mietaime 1s difficult to judge since all timing data refers to 
the running of the overall program. The estimate for in- 
meeased run time for tire’ ninth order filter is on the order 
ee 20 to 50 percent, depending on overall program run time. 
lreSrnecreased Tun time andistorape requircimcnts result 

from the requirement that the ninth order filter must have 


ay 
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Figure 2. General block diagram of Radar Subroutines. 
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aiiadvysewhich are 9 x 9, While the sixth order filter requires 
only arrays which are 6 x 6; 18 of these arrays are involved 
Hesulfting Im a factor of 2.25 increase in array storage alone. 

The prediction calculations for the sixth order fil- 
ter differ from the ninth order filter only in the fact that 
the acceleration terms aré missing in augmenting the pre- 
meted vyellocity components. 

RADAR6 was used to develop the Coarse Guidance pro- 
gram since no mention of autopilot bias problems was found 
in the available documentation on that original system, [8] 
and [9]. RADARS was developed directly in response to the 
bias problem and was therefore used exclusively in the im- 
provement of the Precision Guidance simulation program. The 
two subroutines could be interchanged to work with the other 
Simulation mode's program in a matter of minutes, should this 
me desired, 

foe initialization and Constant Array Calculations 

Upon entering either RADAR subroutine for the first 
time, logic passes control through a section of constant 
faray calculation and definition of program constants. fhe 
constants specified at this point are primarily those which 
are used in bank and turn angle equations. These are a 
function of the aircraft type and update intervals and re- 
main constant throughout a given simulation run. 

A total of five arrays are defined at the program 
Start and remain constant. An Identity array of order equal 


mo the filter order is set up. The Measurement matrix, (H), 


Zo 





aS fiven in either (17) or (19), depending on filter order is 
then defined. The state transition array, $¢, is considered 
constant for this application and is defined in accordance 
with the filter order. The Q matrix, which is a measure of 
the expected unknown random forcing to be applied to the sys- 
tem is computed using the [ array as given in (44) (for the 
ninth order filter) in conjunction with the expected value 

of the random forcing array, W. For this study, W has been 
set nO eies sc saniducrrcets Or on- Zero values in this ar- 
ray are discussed below. 

The covariance of the initial state prediction vec- 
tor is set to 10°, a somewhat arbitrarily large number. The 
effect of choosing such a large variance on the states is to 
@ause the filter to set the initial state estimation vector 
Equal £6 the observation. in other words, the filter essen- 
tially ignores the a prtort information set in as initial 
@Senditions. This is a very typical method of initializing a 
fanear Kalman fiiter, when little confidence is placed on 
any initial estimate of the states. The original simulation 
programs followed this practice (of zero initialization) and 
it was continued mcne Improved Version, —However, consider- 
able improvement in initial filter settling for the Kalman 
m2ters implemented could be achieved through the use of 
good initial conditions. The improved version of Coarse Guid- 
ance yields good estimates of the aircraft position, and in 
moass-Off” to the Precision Guidance mode in a “live run" 


Mmeestatcs active in Conirse Guidance at the time would make 
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valid initial conditions for the Precision Guidance radar 
folter. 
G. PREDICTION ERROR, THE GAIN SCHEDULE, AND COVARIANCE OF 

AIRCRAFT MANEUVER 

The gain matrix, G(k), determines to what extent the 
data will be permitted to affect the state estimation. Dur- 
ing the initial few estimations, the data usually always 
plays a large role in determining states, due to the large 
Eneertainties in the actual states specified by the large 
covariances of prediction and estimation. As more data is 
fewer, the covariances fall, and there is less requirement 
momeccept noisy data into the filter to update the state es- 
Pimate. Figure 53 shows a plot of the typical gain schedule 
morecne X Coordinate, G(1,1) term as a function cf time. 
mamudes Lor the primary gain terms in y and z are similar. 
mhe curve 1S approximately exponential in shape, starts es- 
memeially at 1.0 at time zéro, and decreascs monotonically. 
As can be seen from (9), the exact values in the gain matrix 
depend on a multitude of variables, including the states 
themselves in the form Ot Chew matrix. 

Absolute compliance with the Kalman filtcr assumptions 
mesults in a gain schedule which is optimal in the sense that 
the state estimates will be of minimum variance. The use of 
Sianging gains with time is implicit. Note that in the 
Sriginal simulation programs, only constant gain filters 
were used, or in a few instances, filters which started at 
mic. constant gain value and then switched to one different 


Set of gains. 
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The .gains are related to the filter bandwidth. High 
gains correspond to wide bandwidth since they "let in" nearly 
all of the measured data, including the noise on the data. 
Lower gains correspond to narrow band filters since very 
little data gets into the state estimation calculations. 

Use of low gains also resembles a narrow band low pass fil- 
ter in the phase lag which results in the state estimation 
vector due to an abrupt change in the actual states. When 
this results, large differences begin to develop in the pre- 


diction residual of the estimation equation (11): 
E(k) = Z(k) - H(k)X(k/k-1). (59) 


In this case, (59) simplifies to 


ey ee ee ea) (60a) 
Oe yg * YUKA) (60b) 
as Lane zZ(k/k-1). (60c) 


As the differences in equations (60) begin to be biased either 
positively or negatively over a period of time, the filter 
will begin to integrate to a new trajectory in state space to 
compensate for the fact. The lower the gains, the longer this 
process will take. 

If no random excitation noise, or no unknown BORGES 0 i 
lincertainties are present in the system whose states are to 
be estimated, then the proper setting for W, the covariance 
Muprandom State excitation, 1s 0. Since the Q array in (9) 
1S 

Q(k) = T EIWW'yr’, fone) 
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fee 1S O, then Q will also be 0. Examination of (9) in this 
case will reveal that as t~~ the gain schedule will go to zero, 
and as a result data will have little effect on the state es- 
timation process after a relatively short period of time after 
miitialization. This is fine if all factors are known. 

In real systems, all factors BE eine the states are 
rarely known. Uncertainties in AN/TPQ-27 might include wind 
velocity, exact aircraft roll response, biases in measurement 
equipment, and time variations of all of these. 

The goal in establishing improved simulation programs was 

jto devise techniques which would perform the required estima- 
rion Bd tracking assuming the above uncertainties did not 
jexist tO a Significant extent. This attitude seemed to follow 
that used in the generation of the original program. It was 
‘recognized that use of a gain schedule which goes to zero is 
not a likely useable solution to the problem; however, it did 
seem reasonable to try to generate a solution which worked with 
Mero QO when the uncertainties did not exist. With this ac- 
complished, actual utilization of the algorithms against real 
data will determine the extent to which the bandwidth must be 
opened to achieve nembenkt results. 

Selection of Q is a problem which perpetually plagues 
msers of the Kalman filtcr. Any given data set will have a 
given Q which will yield best results in terms of a specified 
meeiOrmance criteria, normally tracking precision. The Q can- 
not be selectcd with the benefit of hindsight, and must be 
sen Pom relhd tne vOpLimum pertormanee over the cnscmble of 


State trajectories of interest. The normal method for finding 
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this value would be to take as many raw data tracks as possi- 
ble, and try to determine the Q using statistical methods. 

An alternate technique to generate Q on-line through the 
use of prediction error is described in [10]. In this paper, 
Aldrick and Krabill propose the calculation of Q by the fol- 


lowing method: 
Q(k) = a[Del(k) De1(k)'] + b[Del(k-1) Del(k-1)'] (62) 


where a and b are constants to be determined by analysis of 


actual data, and 
EMG ne on an Gla) eee a 


This method was investigated to a limited extent, and showed 
some promise if refined. Simple use of (62) seems to open 
the bandwidth wider than is desired. It has the advantage 
over the use of some constant Q for all runs that, in theory, 
if no uncertainties exist, the Del(k) arrays will be zero 

and thus Q will be 0. Thus, wide bandwidth is achieved only 
when required, as determined by prediction success. In prac- 
tice however, it was found that this method caused the gains 


to oscillate, and created excessive error. 


-_ 


me )=REDUCTION OF COMPUTATIONAL TIME 

The most obvious disadvantage of using the Kalman filter 
eompared with the constant gain alpha-beta filter is the in- 
crease in complexity and computation time required to compute 
mms Optimal gain schedule. There are several techniques 
mrrch can be employed to reduce this burden, all of which re- 


Meee in further loss of optimality, but to limited extents. 
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In general, the R matrix is a function of the states or 
position of the aircraft. If the rough start and end 
points for the tracks to be followed are known in advance of 
the mission, it is possible to compute the average R, 9, and 
@ and thus an average R matrix. Unless R, 8, and $¢ vary over 
wide ranges, the loss in optimality by this approximation 
should be small. Since the gain schedule in state dependent 


only to the extent that R is state dependent, the gain sched- 


ule can now be computed and stored is a mission data table, 


and thus need not be computed on-line. Since 18 different 
gains are required by RADAR6 and 27 by RADARS for each sam- 
ming time, this becomes a rather large problem if auxillary 
storage is not available. 

An alternative to storing the gain schedule is to fit 
Beach of the gain schedules to either an exponential curve or 
to a function of the type 


f(x) = a+b ee did a (64) 


Then only 18 (or 27) computations would be required at each 
sampling time. 
Whatever technique is chosen to approximate the true 


mein schedule, it will not be nearly as sub-optimal as a 


constant gain over all time, or two constants which are 


Bywitched in and out. 
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Iti. PRECISION GUIDANCE SIMULATION 


A. INTRODUCTION 

A limited amount of Precision Guidance simulation program 
documentation was provided with the original version of the 
program. This greatly facilitated understanding of the 
original version of the program, and also subsequent oda 
cation for improvement. Many of the original concepts used 
were not changed. Input and output formats were revised for 
ease of use and to provide a greater indication of program 
performance. Since large portions of the original program's 
logic and coding have been retained, these may be mentioned 
and summarized lightly for continuity. The derivations and 
justification of assumptions in these areas will not be ad- 
dressed, as they are considered to be adequately documented 
in the existing system documentation. 

A block diagram of the simulation program control loop 
HS presented in Fig. 4. In a few words, the program starts 
with the aircraft at some designated position and velocity 
Bera respect to a target which is to be bombed. After a 6 
Beemirtiter settling period, control logic determines the 
meterdal error which will be incurred if the present flight 
profile is continued until time to release the bomb. Func- 
mrons of the lateral error become the controlling mechanism 
to generate command bank angles which cause the aircraft to 


Change course. It is emphasized that all control commands 
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are based on estimated positions and velocities. Thus it 

may be possible to drive the estimated lateral error to zero, 
and still miss the target considerably, if the state estima- 
tion vector is in error. One further comment is that the 
problem is not totally one of estimation and control. The 
aircraft has a bank angle limitation imposed of + 30 degrees. 
This limits the turning rate such that, depending on the 
initial position and velocity with respect to the target, 

the aircraft may not be physically able to come about to the 
correct heading in the time required. Examples of this situ- 


ation. are provided. 


B. INITIALIZATION AND FILTER SETTLING TIME 

The new simulation program is functionally similar to 
the original version in initialization. The same variables 
are used wherever meaningful. The coordinate transformation 
vectors and matrices defined during initialization are re- 
tained, as are all equations for operating in the dive bomb - 
mie mode. (ihe original program provided logic for executing 
a diving mode, oe use of this mode has not been investigated 
ma this study.) ‘a 

The ceon radar SopiiniewretceioeontlZ- NG 2ctCioh ex 
Sept state estimation is taken during the first 2 sec of the 
Simulation run. At the 2 sec point, logic is executed CO. ene 
mee prediction of the lateral crror at 6 seconds into the 
mum, tithe 4 second lag is assumed to be due to an attempt to 
Simulate the fact that the actual computer used is computc- 


fmme limited, thus constraining the integration loptc to 


So 





oe 


execution at no more than 0.25 Hz. At t = 6 seconds, the 
lateral error is first estimated, and the first non-zero 
command to the aircraft can be transmitted. 

C. PRECISION GUIDANCE COORDINATE CONVENTIONS AND TRANSFORMA - 

TIONS 

Three primary coordinate systems are used in Precision 
Guidance calculations. These systems have their origins at 
the target, the radar, and the aircraft. <A convention in 
notation is used throughout the program to denote vectors in 
the various coordinate systems. Xi represents a position 
mweectonr, AN) represents a velocity vector, and XDD! represents 
an acceleration vector. (The only time acceleration vectors 
appear are in RADARS.) The number "i" in the notation simply 
Merers tO a Specific coordinate system. 

M~rcOECScitS tne Stace estimate Of the aircrait in the 
maddar reference frame; X2 represents the true state vector 
mmetne alrcrart in the radar frame. X3 represents the state 
feeror Of Che aircrart in the target frame. Conversion from 
ee irame to the other is accomplished through the use of 
transformation matrices Pit eaMz ondeEvl and the SUDrOUtInNESs 
MATMLT, and MATMAD which Petrone Matrix multiplication 


and addition. The relationship between X2 (or Xi) and X3 is 


Sallustrated in BAC a Se 


Mirecrart CoOnerol 15 derived through the use of the X6 
e00rdinate system, which has its origin at the aircraft and 
feemy 2xis Oriented along the estimated aircraft ground head- 
ieee This transformation is accomplished through the coordi- 


MeecechanstoOrmation matrix EMS. Figure 6 illustrates the 
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| the relationship between this coordinate system and the tar- 


' get. Note that in the case of perfect estimation and no 


wind that this y axis orientation would point directly at the 
ar eet. 
Each of the X, XD, and XDD vectors are of dimension 3, 


one storage allocation for each physical dimension. Thus, 


X1(1) = x1 
X1(2) = yl 
MACS ez. 


The coordinate systems and transformation equations are 


fully specified in [11]. 


D. LOOP GEOMETRY AND ERROR CALCULATIONS 

The normal fliow of control through the main program loop 
following the initial 6 second settling period begins with a 
time update and a movement of the aircraft in accordance with 
the command bank angle generated at the previous time, all 
Within the original subroutine ARCRFT. The true position is 
then transformed into the radar frame, noise added, and the 
new state vector estimated using the RADARS subroutine. The 
estimated state vector is then transformed into the X6 ,XD6 
system, sometimes referred to as the “double primed" reference 
system in the original program documentation. 

As mentioned previously, every 4 seconds the simulation 
Paeeranl Computes NeCw COcTTicicnts which are uséd to calculate 
Bie ballistic range to the target, and bomb time of fall. 

Mmiis involves integration of a system of 16 differential cqua- 
tions telat a fourth order Runge-Kutta scheme. The ballistic 
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range (RA) and time of fail for the bomb (TF} are computed 
uSing a first order linearized approximation to the system 
of equations described above at those times when no inte- 
gration has been performed. Subroutines STIFF, DER, and 

OUT are used to perform the required calculations; these are 
completely specified in [10]. 

The ballistic range, RA, is the distance the bomb will 
ipact from the present aircraft position. fFime of fall, 
TF, is the time in seconds which will elapse between bomb 
release and impact. These values and the ballistic wind 
components in track and cross-track to the aircraft estimated 
heading determine fhe impact point for the bomb in XO refer- 
ence frame. The equations for this estimated impact point, 
(XGC,YGC), are as described in [11]. Figure 7 illustrates 


the geometry of the situation for the windless case. It is 


massumed that by selecting the bomb release time carefully, 


Mmtecatl~ZeTrO €rror in ampact on the yo axis can be achieved. 
nly by having the aircraft heading precisely correct will 
the cross track impact error, called lateral error (XE), be 
Zero as well. 

At each sampling point, the Time-to-Go-to-Release the 


bomb, TG, is computed using 


Gey Gee Gly .o.. (65) 
mime lateral error is given by 

MEH Kote AGC. 
emer quantities which are used in error calculations are 
Beemballistic range to the target, RBT, and the heading angle 


Meror, HDE. These are given by 
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1, 
RE exo > fy 57) - (67) 
where XS is the coordinate system X6 prior to being rotated 


for heading-target alignment, and 


HDE aeestilcxL, RB} (68) 


tl 


me AITRCRAFT CONTROLLER DESIGN 

The new controller for the aircraft is considerably less 
complex than that originally used. The original version em- 
ployed lead-lag networks, suitably digitized, with constants 
which were switched in or out at different stages of the 
Simulation run. The lateral error was driven to zero in the 
original version of the program, by selection of a gain con- 
Stant times the lateral error to yield a desired bank angle. 

ihe mew controller design attempts to drive both an 
error and an error rate to zero. The error signals to be 
driven to zero are the heading angle error, HDE, and the 


meading angle error rate, HDEDOT, where 


HDEDOT = HDE. (69) 


mie desired control bank angle, ® a: 1S given by 


4, =-G, HDE (70) 
49 = G, HDEDOT C70) 
and oF = O01 + da0° (72) 


This procedure requires selection of the feedback gain con- 
stants G4 and G.. Meeonouldsbeemeted at) this time that Gy 
and G. ieCmtncmonny  tWO CONStanes, in the simulation prograin 


merch must be determined "through simulation," i.ec., by 
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trial and error. The original program was filled with 
numerous ''gain constants" which were, or were to have been 
selected by "simulation." In addition, in the original ver- 
Sion, much of the theory was developed through the assumption 
that the process was approximately a linear-one, and develop- 
ment of a linearized model which reflected these lineariza- 
tions. Such linearization may be somewhat valid in the final 
stages of a long run where only small commands are being sent, 
but in the initial phase of heading correction, the commands 
saturate and the assumption of linearity is invalid. It is 
in this nonlinear region of operation that commands must be 
optimized to yield a combination of rapid correction of head- 
ing error and minimum overshoot of the correct heading. 


Two sets of control gains have been selected for the 


two prevalent aircraft roll response time ccenstants, Th = 2 
and con = 3.3. The gain constants are given below. 

as Ze Gy = G, = 75 

1S es ote Gy = G, = 150. 


These parameters were selected through analysis of numerous 
simulation runs with each ie and subjectively evaluating the 
resultant performance. The performance criteria used was to 
Penerate initial commands which are of the "bang-bang" type 
meererred tO 1m Optimal control theory, cattsing the bank com- 
Mand to Saturate at the autopilot limit of + 30 degrees. 
mits Causes the aircraft to begin turning toward the correct 


heading at the maximum possible rate permitted. The effect 
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mot heading error rate control is to act as a damper in that 
the faster the heading angle changes, the more the control 
will begin to decrease. The second Bane of the performance 
criteria was to require that when small angle errors are 
noted, only small commands are generated. 

There 1s a requirement for no bank commaids during the 
final second of flight. This is to ensure that the aircraft 
does not make a violent maneuver just as the bomb is dropped, 
Eausing the bomb to be pitched from the aircraft rather than 
Simply dropped as had been assumed in the bombing calculations. 

For a one second period beginning three seconds before 
bomb release, i.e., TG = 3 to TG = 2, the average estimated 
' aircraft bank angle is computed. This average estimated bank 
angle is then sent as the command during the final two 
seconds before bomb release. The reason for sending this 
value vice a command of zero degreeswis che possiole pres- 

ence of a bias angle. Figure 8 is a plot of a typical simula- 
tion run in which the autopilot has a bias bank angle of 3 
megrees. Note that this bias is automatically compensated 

for by the commands sent. The average command at the end 

ee the run is Pemeaianely -3 degrees. This has the effect 
Merolling the aircraft back to a level flight profile in a 
mecady-state Situation, vice a slowly turning profile which 
would be present if the command was 0 degrees. By averaging 
the estimated bank angle over the period defined above, and 
sending this value for the final few-seconds, the aircraft 


Continues on an approximately error free path. A zero command 
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at this time would cause the aircraft to begin a slow turn 
and greatly increase the lateral error with no opportunity 
mor Correction. 

Command system requirements require that the command 
miele be quantized to the nearest 15/128 degree. This is 


accomplished through simple logic as described in [11]. 


F, PRECISION GUIDANCE PROGRAM IMPLEMENTATION 
1. Main Program and Subroutines 
The Precision Guidance simulation program consists 
of a main routine and seven primary subroutines. The pro- 
gram listing is appended at the end of this report. Each of 
fae SUbroutines is included and in each of the routines the 
primary variables and purpose of the routine is specified. 
Sch the €xception of subroutines STIFF, DER, and OUT, which 
merve Only to support the Runge-Kutta integration defined 
epove. tlhe simulation program was written to run on an 
IBM 360-67 computer system and takes advantage of several 
of the system software subroutines. The program with link- 
age and subroutines requires approximately 150 K to execute 
and Will run a typical time of from one to three minutes of 
CPU Cm: Sonennercion Bedtieres wa yprendlavely o0 seconds. 
AP tUStiniceor tne Vvartables used in Lhe program along 
meen the variable definitions is provided in Appendix A. 
aoe Program Input wand Cutput 
Speci tiemommat definitzons «cor program input data 


mee provided in Appendix B. The program output has been 
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i 


J 


i'changed significantly from that in the original program ver- 
Sion. A sample of one complete simulation run is provided 
Dat the end of this report. The initial conditions and con- 
meats are OuUtputpalong with short word definitions of their 
meaning or useage. Each second, a summary of the critical 
parameters of the program are output in block form; the out- 
put key is printed on each page for ready availability to 
the user. During the final second before bomb release, the 
eritical parameters Summary 1S printed at every sampling 
polnt. 

On the final time through the main processing loop, 
PeeeecstiMates are replaced by their corresponding true values, 
pada the bomb “released." The impact point is computed, and 
fie Miss distances in x,y and overall are printed, designated 
fe, YI, and RI, respectively. 

As a measure of filter effectiveness in noise reduc- 
tion and state prediction in position including deterministic 
motion, the square of filter residual is summed throughout 
tine run. The RMS values of filter residue are printed fol- 
Howing the bomb impact miss distances. Filter residue in 


mrs sense is defined as 


FILRES) == (psa) 
FILRES,, mye ty 2 (73b) 
FILRES | = Zz] - 22. (Se) 


meaddition to the filter residual in each coordinate, a 


madial residual defined as 


a 





FILRES, 


1. 
= (FILRES, * + FILRES, ° + FILRES,*)* (74) 
mseprinted im RMS form, where the average is over the entire 
Simulation run. 
Some of the critical parameters are stored in arrays 
mien Second throughout the run. These are then line printer 


plotted at the completion of the run with appropriate 


labelling. 





IV. COARSE GUIDANCE SIMULATION 


A. INTRODUCTION 

Two documents, [8] and [9], were provided to describe 
the techniques and general approach being followed on the 
original Coarse Guidance simulation program. However, no 
program documentation such as that provided for Precision 
Guidance, [11], was available. The program provided seemed 
inordinately complex in some places and the general approach 
to the problem did not appear to be a viable one from which 
to build an improved version. 

It was determined that the best approach would be to write 
a totally new main simulation driving routine, use the already 
existing aircraft simulation program, ARCRFT, and the already 
developed Kalman filter radar simulation program RADAR6 to 
Simulate the Coarse Guidance tracking system. RADAR6 was 
chosen vice RADARY simply because neither [8] nor [9] men- 
tioned any difficulty with bank angle biasing. Also, the 
Smaller size and faster running time of RADAR6 made that sub- 
meutine a preferred choice. The decision to mate RADAR6 to 
Coarse Guidance rather than RADAR is by no means a final 
choice. A matter of only a few minutes would be required ae 
modify RADARS to be compatible with the Coarse Guidance sim- 
Miation program. Thus if biasing is a problem in this mode 
also, RADARS could serve as the appropriate unbiased state 
estimator. The changes in RADARG from RADARO other than 


mmose which relate to accelcration estimation will be discussed 


wn 
tad 





below. A few simplifying changes in the ARCRFT subroutine 


—_— 


te 


were also accomplished to reduce core storage POCnnee ete 
and execution time; these will also be described. 

Some of the concepts and a few equations from the origi- 
nal documents on Coarse Guidance were used in this study. 
Since the new simulation program differs significantly from 
the original version, nearly all equations will be presented 
and most will be derived. 

The basic concept in Coarse Guidance is to get the air- 
craft from some initial starting point to the final bombing 
mimeby Llying a predetermined course which is specified by 
"“waypoints'’ and azimuths of course "legs."' A typical simu- 
m2er1on Setup might appear as illustrated in Fig. 9. The 


designated legs presumably follow a "safe" path for the 


Mstrike aircraft. Also, presumably, if the aircraft deviate 


1 from the specified path too far, they become in danger. 


mherefore, it is desirable to provide some control to keep 
the aircraft as near to the specified path as possible. Of 
marticular importance 1s to recognize the approach of the 
beginning of a new leg and begin a "command turn" onto this 
mew leg at such a time that upon completion of the turn, the 
mrcratt will be on the new leg with the same ground heading 


as the leg's azimuth. 


B. PRE-MISSION DATA TABLE COMPUTATIONS AND INITIAL CONDITIONS 
Siecethie pathmco be flown is specified, the individual 
Mees can be characterized by their azimuth with respect to 


Bemth and their length. The beginning of the mission is 
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referred to as a TACAN Entry Point, and is the approximate 
position of aircraft entry into the probles. Wind causes 
the ground heading and the air heading to differ. Since 
most of the aircraft control calculations are made with re- 
spect to the air heading, effects of wind must be considered. 
mie Initial position of the aircraft is nakesecl at the begin- 
ning of the first leg perturbed by some error, and with 
ground heading of the first leg's azimuth also perturbed by 
some angle deviation from desired. 
1. True _and Estimated Wind Components 

Figure 10 illustrates the relationship assumed for 
wind in the problem. Provision is made for an error in es- 
timated wind speed and direction. All true aircraft motion 
1S computed using true wind. All estimated aircraft motion 
and control decisions are made using the estimated wind 
components. Wind is assumed zero in the vertical direction. 
If the true (estimated) direction toward which the wind is 


blowing is 6 Glare and the true (estimated) wind speed is 


W 


a (VD tiene thie commoments Of wand are e#yen by 
= is 
Mi Ve Sin (6, ) (75a) 
z : 75b 
Wy, Vee cos (8, ) (75b) 


for the true wind, and 


sche & Vwh sin (6.4) To) 


“yh = Wh oe a 


ior the estimated wind. 
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Figure 10. Illustration of Wind Relationships. 
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Figure 11. Illustration of Waypoint Coordinate Cal eieat lose 
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Z. Mission Data Table Calculations 

Included in the mission data table are the waypoint 
coordinates, average radar range to each leg, average radar 
azimuth to a given leg, desired air heading while on each 
leg, desired ground speed while on each les, approximate 
time to fly each leg, and the ground velocity components 
for each leg. 

For notational purposes, it is assumed that there 
are a total of n legs to be flown; a subscript i on any 
parameter indicates that parameter for the a" Peet Oune 
11 illustrates calculation of the i+l waypoint coordinates 
from the previous leg's parameters. If (xep. ,yWp. ) avec ene Mie 

th 


coordinates of the ie Waypoint, the azimuth of the i leg 


is 0. and the length of the ih Veg as L., then 
XWp . 


i+1 = Xwp; + L; sin(@,) (77a) 


YWPi4, = yWP; + L, cos(@,). (77b) 


th 


The average range and azimuth to the i leg, R. and 


Az, are given by 


2 1. 
Rae a( (xwp, +xwp, .4)? + (ywp.tywp.,,)°]* (78) 
. xXWp. + XW). 
Az. = arctan| ——2 —__itl (7 3)) 
‘| ywp, + YWp. 44 


Figure 12 presents geometry which aids in clarifying 
Calculation of the air heading and ground speed, assuming 
the air speed is a known constant. (This assumption is 


Maintained through the problem and seems reasonable, since 
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Figure 12. JTllustration of Ground Speed and Air Heading 
Calculation Geometry. 
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the pilot has a 


direct readout of his speed with respect to 


the air.) Since it is desired to fly along the leg, it is 


correct to sum components perpendicular to the leg and set 


these to zero. 


the air heading 


Vonoin (As - 0.) + Vepoin (8. - 6. 


Jog orn is the estimated air speed and H. 1S 


then 


J = 0. (80) 


Summing components in the direction of the leg yields the 


desired ground speed 


on = Voncos CGA; - 0.) = Vin cos (8, - 6.) (81) 


ran G€an be broken into Cartesian components, V and V as 


toOllows: 


Vox 


V 
BY 


The air heading 
by solving (80) 


H. 
1 


See Initial 


gx SY 


V 


gndinté,) (82a) 


V 


hos (85) - (82b) 


mequiredetouLly Inne the dinection 0. is found 


i Osos lee 
i 


V 
7 2 . wh . b 
= G; sresin| gi sin(o 22 | ° (83) 


a 


Position and Velocity of the Aircraft 


iiemiiittrdiatmtcsnosituien Gf the aircraft 15 that of 


the first waypoint plus a perturbative error. Since the way- 


peint is on the 


PToUndythesaltittudeme: the alrcratt is given 


Mey the perturbation in the z coordinate. The true position 


mee the aircraft 


x5 = 


-y 


ves 
ZS 


ESC OMmtadmed wal wtien \ array . 


xwp, + Ay (84a) 
= ES es ao (S4b) 
= A. : (84c) 
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The initial true ground heading, He? is read as data. 
This in addition to the known airspeed, Vo Specifies the 
true ground speed, Vos and the true air heading, Ha» through 
a set of equations similar to (80), (81), and (83). The re- 


sults are given by 


V 
= 2 me gare 3 
He = Hy sresin| gt sin(@,. ip] (85) 


and by 


V 


g As cos (H, - He) # v cos (0, - H 


gi (86) 


“The initial true velocity of the aircraft is then broken 


into Cartesian coordinates and stored in the XD3 array. 


3 = V_ sin(H 87 

x g sin( g) (sy) 
-y3=V H 87b 
y g cos(H,) | (87D) 
z3 = 0. (87c) 


mee that 1t 1S through specification of He different from 
O15 and A. and Ay idte pentusrOnleo iia cb Nonzero perturbations 
mm velocity and position from the desired values are entered. 
Figure 9 also shows the geometry which might exist in the 
case of nonzero displacement ands Vellocity irom the desired 


rack, 


meee ALRCRAFT POSITION, VELOCITY, AND ERROR ESTIMATION 

me previously stated, aircraft motion 1s simulated by the 
use of a slightly modified version of subroutine ARCRFT as- 
Meeraced with Precision Guidance. Position and velocity es- 


fimation is accomplished using RADARG. At the beginning of 
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the main processing loop, true aircraft position is updated 
‘followed immediately by a prediction update on estimated 
aircraft position. A new estimation update is performed 
only if the total radar sampling interval DTRAD has ellapsed. 
(It is assumed that prediction updates occur at a higher 
rate than radar sampling.) The most current aircraft posi- 
tion and velocity estimates are contained in the X1 and XD1 
arrays. From this and the estimated wind components, the 
estimated air and ground headings, and estimated ground speed 


are computed; How H oh? and V oh? TesMe ceived y. 








om = arctan 2] (88) 
3 lw 
Eee = arctan] xn | (89) 
, yee Wyp J 
Vue (xl? + y12)% (90) 
gh y : J 


These parameters can be monitored to determine the degree 
of error in heading and speed from the desired values. An 
additional and important parameter to be monitored is the 
Merent CO which the aircraft has deviated from the desired 


- 


BOUrse , Ean Pecurer loumihistrates tlle —feo0metry used in 


this calculation. The error is given by 


eee a (x1 - xwp  ) cos (6, ) alae ywp. ) sin(0.). (91) 


Note that (91) computes the distance from the present posi- 
meon estimate to the leg 1. In a command turn, the aircraft 


Should not be on either lec, but wil] be somewhere between 


> 3 
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Figure 13. Illustration of Geometry FOr oaleculating VDeviat pon 
from the Desired Leg Path. 





th and 


'the legs. For this reason, distance from both the i 
itl leg is computed, and the smaller of the two values 
chosen. 

True headings, speeds, and distances corresponding to 


those given above are also computed using the same equations 


with X3 substituted for Xl, and W substituted for Wh: 


D. COMMAND TURN CALCULATIONS 

The command turn is that which is computed to cause a 
smooth transition of the aircraft from the present leg to 
the next leg with a minimum or overshoot or undershoot of 
the desired path. The aircraft autopilot is constrained to 
a maximum bank angle, Oo? typically equal to 30 degrees. 
Since the headino angle rate is proportional to the bank 
mamele in a coordinated turn, the time to complete the turn 
using the maximum possible bank must be precalculated so that 
Mmeeeturn Can be started prior to reaching the new leg. This 
mmeocess is complicated by three factors. The first is that 
fae time to the next leg is variable with the current posi- 
Pion and velocity. Thus the time to begin the turn as well 
as the amount of heading change required is a function of the 
meate estimate. The second Pact OLwlS atidtatLMe sequation LO be 
meevine tor the amount of time required for the turn is a 
transendental equation and must be solved through iteration. 
Mme third factor is that this equation becomes unduly complex 
Mmethe turn is not started from a zero bank angle. This re- 


meres that the aircraft begin the turn in level E ilestgtea ge 
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Pee licemeiiainamle On Present Leg 


The time remaining on the. present leg before inter- 
secting with either the next leg or its extension is com- 
puted by finding the intersection of the two paths, calculating 
the distance to be traversed, and then dividing by the esti- 
Mated ground speed. The geometry is illustrated in Fig. 14. 
The coordinates of intersection of the present path, 
based on the present velocity estimate and the next leg are 


designated (x. 


See ae Let mi; and Ms 4 


, represent the slopes 


Be the present aircraft heading and the next leg, respectively. 


Then 
m. = y1/x1 (92) 
Mca - (YWP sa 7 ywp;)/(XwP; 44 ' XwWp, ). (os) 


The equations of the two lines whose intersection is to be 
found are 


x - 


< 

II 

= 
4 
ea 
paaed 


(Ms 44 XWPi 44 7 YWP. 44) (94) 


Vee Me (m. Seley ve (95) 


These equations are solved simultaneously to give the point 


of intersection. 


(jee YWP; 4) + (Ms 44 XWP. 44, 7 MM, i) 


a 
ena ey ee u eee (96) 
IG (Mm. 44 m. ) 
ee aint i ee oD) 


The distance between xl and the point of intersection is then 


Deen - y1)?]" (98) 


2 2 , 
tg xelg| + ( 


ae Int 
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Figure 14. Illustration of Path-Leg Intersection Geometry. 
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and the time to reach this point is given by 


TLEGL = DL o/Von- (99) 


el inicekequined tomeomplete the urn 


The amount of turn required, AH, is simply 


Pat) - . (100) 
Air headings are used in the calculations since all aircraft 
motion and turn equations must account for the possible pres- 
ence of wind. Equation (50) gives the relationship between 


the change in heading angle, time in the turn, and the roll 


response of the aircraft. Setting AU equal to AH and $9 


c 
equal to De gives COA} 
a | -T/t 
eet ates a « fF; mm ri ftoaNn J = b 
AH = 8 an? [Pn Pees Woe ites = S yf. 


zl 
If‘it 1s assumed that $(k-1) is zero (starting with level 


flight), then the equation can be rewritten as 


-U 


Kr ee) (102) 
where 
= T/T, (103) 
and ” 
AH V h 
Ge pte (104) 
ee om | 


For pene spurpose GL findime the turn time required, 
mecume that the turn can be divided into three parts as il- 
moemdecd 1m Fig. 15, the first part 1s the transiént period 
during which the aircraft is coming to the maximum (or minimum) 


Bank angle, going to that limit exponentially with time constant 
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Baeure 15. Illustration of Relationships Between Times and 
Bank Angles in a Command Turn. 
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Th The second part of the turn is that segment when the 
aircraft is holding at the bank limit and changing direction 
with an approximately constant heading rate. The third and 
final part of the turn is a transient segment during which 
the aircraft returns to a zero bank angle, also exponentially. 
PicinemloesnOwS that tne Curm Can be divided into 
two approximately equal parts, during which the aircraft 
executes approximately half of the turn, AH/2. Let the time 


mequaired to complete half of the turn be T and, Ele Lames bo 


(Gta 
complete half of the constant bank segment of the turn be 
TO2° If K, above, is replaced by K/2, then the solution to 


(102) yields 
Ue Wsliees/ 1. (105) 


The equation is solved using the Newton-Raphson iterative 


fmerennique. ithe initial approximation to T is taken from 


ee 
[9]. Iteration continues until the change in Th is less 
Phan 0.01. 

Motion of the aircraft through the turn is approximated 
mi nearly the same manner as described in [9]. Briefly, it is 
assumed that the aircraft continues on an approximately a 
Straight ae for a period Th27T 92 seconds after the command 
femme 1S ordered, followed by the command turn as described 
above, followed by another period of approximately straight 
flight along the new leg during the final seconds of the turn. 
A diagram of the geometry ot the turn 1s presented in Fig. 16. 


Since the turn has been computed with respect to the motion 


Meethe air mass, movement of the air mass during the turn is 
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compensated for. The only modified equation used to calculate 
the distance prior to leg intersection from which the turn 
must start is that which relates to air mass motion. The new 
equation for computation of the parameter Dx Pomc Cimcon — 
mectly by 


ee T 52 vy sin(6. 14 - 8h) sin(®. 4 - 6. ). (106) 


mye turn must be started a distance De before the intersec- 
tion with the next leg, where De is shown on the illustration 
and mathematically defined adequately in [9]. 
3. Command Turn Timing Logic 
The time-to-go before beginning a command turn is 


given by 
Te =“TELEG1 - Ds/V oi (107) 


When TG is less than or equal to zero, the aircraft is com- 
manded to go to the maximum bank angle, with the sign of the 
bank chosen appropriately. The time to command the bank 


engle back to zero is T and 1s given by 


stoptn 


e ; 108 
ae en ee (108) 


miitially it might appear that ST) should be subtracted from 
the total turn time, since that would be closer to the amount 
of time required to decrease the full bank angle when the 

| Change is occurring exponentially. However, this value was 
merived at through simulation trials, and is probably best 
due to the compounded approximations made in the overall turn 
memeron. the time at which the turn 1s complete is defined 


as Th NOwagetrons depend on this time. 


ial 





Figure 17 is a logic flow chart of the start/stop 
turning process. Briefly, a counter in the form of the 
variable TINTRN is incremented each time through the loop 
as the turn progresses. The variable ITURN is used as a 
flag to pass logical control to the correct coding. When no 
turn is in execution, ITURN = -1, and the only turning which 
is performed is that to correct the course deviations. No 
control banking for the above purpose is permitted within 
the 3T) seconds prior to executing a command turn. This is 
to ensure that the bank angle of the aircraft is zero when 
beginning the command turn, an assumption which was used in 
the derivation of the command turn equations. During the 
command turn, ITURN = 0, and all control logic is bypassed. 
mimediately upon executing the logic which indicates the turn 
as ending, ITURN = 1, and calculations to check for the next 
turn time begin. If required, a new command turn can be 
executed immediately, before the aircraft has come down fron 
its bank from the previous turn. This feature was added to 
Bisure that if a short leg or a very acute turn was encoun- 
mened. the best possible flight trajectory would be flown. 
meamples of the requirement for this feature and its perform- 


mice are included. 


Pe AIRCRAFT CONTROLLER DESIGN 

The controller, used to guide the aircraft to a desired 
Betlocity and keep it there until a command turn, is of the 
meme type used in Precision Guidance. In thas case, the con- 
meorler attempts to keep the estimated ground heading, ra 
hee 
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at that heading from the current estimated position which 
will fly the aircraft directly at the next waypoint. This 
scheme was selected for two primary reasons. The first is 
Pidtwit Teaquilres Minzmal control to get the heading correct 
and thus requires considerably less updating than the tech- 
nique used in the original simulation Bee Sait, The second 
reason is that this technique tends to avoid the problem of 
Pocmllatton whitch plagued the original scheme. The control- 
ler features a technique which will block any command updates 
to the aircraft unless the heading error exceeds Some minimum 
Error angle, H 


ermin 


The estimated heading to the next waypoint is 


* thee One [ xwPs4y - x1 ] . 
Seer =— Va hee All | YWPsa, yi | ° (109) 





The heading error is then 


_ 7 110 
HDE NDE Hig ( ) 


and the heading error rate, HDEDOT is the discrete derivative 
of (110}. These are combined as given in (70), (71), and 

(72) to give the desired control angle. The gains Gy and G, 
were selected equal,.as before, with the value 4. Different 
feedback gains were used in a number of simulation runs, and 
the results indicated that the system was somewhat inscnsi- 
tive to the values chosen. The gains yielded desired commands 
of about 20 degrees during normal course corrections, and with 
the Wl ere, feature seemed to avoid the undesired oscillation 


for the most part. 
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The commands are quantized before being sent, as in 


Precision Guidance. 


F. COARSE GUIDANCE PROGRAM IMPLEMENTATION 
1. Main Program and Subroutines 

The Coarse Guidance simulation program consists of 
a main routine and two primary subroutines. The subroutine 
ARCRFT used to simulate true aircraft motion, was simplified 
from that version used in Precision Guidance in that all 
dive bombing equations were removed. The RADARO subroutine 
differs from RADARY by the obvious fact that it does not es- 
timate acceleration due to bank angle bias, as well as in two 
other ways. The first is that RADARO is designed to operate 
at a sampling interval greater than the control interval. 
This requires that the subroutine be called, standard predic- 
tion equations executed, and then estimation only if the sam- 
pling interval has elapsed. The second difference is in the 
mee of NWLD. NWLD indicates that "wild points" are in ef- 
fect, and are ignored by the radar filter. This amounts to 
Simple prediction without the benefit of radar sampled data. 

The Coarse Guidance radar receives little if any re- 
curn from the aircraft during command turns. In an effort 
fo Simulate this effect, NWLD is set to a negative value dur- 
mae turns, thus requiring prediction of position and velocity 
based only on past data and commands. 

Coarse Guidance requires a little less than 100 K of 


Sere for linkage and execution. Compilation of the program 


i 





and subroutines requires about 25 seconds, and execution 
requires between 5 and 25 seconds, depending on the number 
of legs and the leg lengths. 

A listing of the variables used in the program along 
with the variable definitions is provided at the end of 
Appendix A. 

2. Program Input and Output 

Speciric format definitions for program input data 
mee provided in Appendix C. 

The program output consists of three primary parts. 
Bhe first part 1s a listing of all input data and simulation 
run parameters. The second part is a summary of critical 
Parameters printed once per second, and the third part is a 
Summary of the deviation error from the desired path, along 
with a plot showing the desired, true and estimated paths. 

At the beginning of each new leg, a summary of data 
fable information 1s provided about that leg which can then 
be compared to what actually occurs. As the run progresses, 
a notification of the three stages of command turning is 
mresented interspersed with the critical parameter summary. 

fiitcwonley wcheorunamec Critic! la selected 15 the root 
mean Square aircraft deviation from the desired path. fThe- 
plot of the paths shows the deviations very well. The plot 
scaling is accomplished to maintain the same scale on both 
Perera trier Vaistal indication of relative error. All 
euEput values are in nautical miles and feet per second, for 


position and velocity, respectively. 
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Vee RboreNTALION OF RESULTS 


A. PRECISION GUIDANCE PERFORMANCE COMPARISON 

In the process of improving, changing, and verifying per- 
formance of the new version of the Precision Guidance simula- 
tion program, a very large number of runs were accomplished. 
A proper comparison between the two program versions re- 
quires side-by-side contrast of appropriate performance pa- 
rameters, each derived from the same set of initial conditions. 

In establishing specific run parameters for the initial 
conditions, three parameter sets were varied: initial air- 


Sratt position, X3, autopilot bias angle, dy» and aircraft 


Neer te Tee” > 


moll response time constant, t,. All other variables in the 
programs were held constant and equal in the two program ver- 
Sions. Variation of the above parameters seemed to yield 
conditions which would ably show those areas where perform- 
ance was improved, and at the same time permit runs with 
initial conditions varying from nearly perfect to considerably 
in error from the optimal initial bombing path. 

Ten different aircraft initial positions were chosen and 
assigned a "run deinen (iementtlaleevelocity on each of 
miese was identical. the resultant geometry created is shown 
meet 15> Note that runs 1 through 5 present a considcr- 
pole More diifrcult mission than runs 6 through 10. ee 
Tilvemean De rowenly equated to the angle through which the 
Piteraet must change its velocity in order to fly toward the 


Sct mrocatecd sat tim origin of the X3 coordinate system. 


ve 
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1. Filter Performance Comparison 


The filters were tested within the framework of the 
Precision Guidance program. The most important performance 
parameter to monitor for this problem is the difference 
between the estimated position of the aircraft and the true 
mosition of the aircraft, already defined as the “'residual" 
mi If and III. Table I presents a senpacteen between the 
Kalman filter and the alpha-beta filter's radial residual, 
mre., total estimation error in position, and Fig. 19 pre- 
sents these results graphically. The numbers shown are aver- 
age radial residuals, averaged over the runs accomplished for 


each version. 


AVERAGE RADIAL RESIDUAL (ft) 


Initial 
‘Run No. 5 Original Version Improved Version 
1 =50 5000 79 15 
Le -40 ,000 LO7 7 
Se = 502 000 154 20 
4. =2.0 0:00 216 Zl 
5. Or O00) 128 cy 
Table I. Comparison of Average Radial Residuals for the 


Alpha-Beta and Kalman Filters. 


The figures show an average percent improvement for 
the new program version of 680 vercent, with a maximum im- 
meovement of over 1000 percent. It should be noted at this 


point that these numbers do not represent the results of a 


cs) 





woe lower rIustration of 
200 Improvement in 
Radial Residual 

Using the Kalman 

Pideters ES tina te tee 


Radial Residual 


VS. 
X3 Simulation Run 
6 beng tli 
150 
Feet 
o) 
(+) 
100 
© Alpha-Beta Eide west dial 
van Kalman Filter Residual CS) 
50 
0 
0 -10K -20K ~30K -4A0K ~SOK 
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true Monte Carlo simulation. To achieve Monte Carlo pre- 
cision would have required an inordinate amount of computer 
Pale meommTOve OF TIlWStrate a point,  Vhe differences in ac- 
curacy presented in Tablclare not simply a result of stochas- 
tic luck on obtaining a "good'' set of random numbers. The 
differences in the two versions represents a biasing in the 
Original filter due to the lack of deterministic forcing. 
This point is brought out even more forcfully in the com- 
mimison Of Fios. 20 and 21, and Figs. 22 and 23. These plots 
show that the errors in estimation for the Kalman filter on 

a typical run are roughly unbiased; however, the biasing on 
Ene e€Stimation in both x and y coordinates from the alpha- 
meta filter is very obvious. Note that, as explained in II, 
eie alpha-beta filter eventually “catches up" to the correct 
Mesition. This occurs only after the initial period of 
banking at the limit is complete, and explains the peak in 
residual error which can be noted on the runs beginning at 
a0 K £t. 

In theory, even if the alpha-beta filter had effects 
of deterministic forcing included, the Kalman filter would 
perform in a superior manner, due to its having an "optimal" 
maim schedule to give a minimum state covariance of error. 

2. Bombing Accuracy and Time Response Comparison 

Two performance’ parameters on the overall Precision 
Guidance routine were observed and minimized throughout 
program development. The importance of actual bombing ac- 


euracy 1S obvious. A less obvious’ but very important paramcter 
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is the time required on the final bombing leg in order to 
achieve "sufficient" accuracy. The longer that a pilot is 
required to fly a straight path toward a target, the more 
his chances of being shot down increase. It is then desir- 
able to swing onto the final leg from Coarse Guidance and 
complete the mission as soon as possible. | 

Winsetime. to be designatea 7. was difficult to mea- 
sure directly. It is a strong function of the amount of 
heading angle change required from Precision Guidance ini- 
tialization. By varying the angles and distances to the 
target-in the runs (1 through 10), it 1s possible to observe 
Pnemanewlm: Or time required tor the Lateral error to reach 
some threshold minimum acceptable value, under which, in an 
absolute value sense, the bomb impact will be scored a suc- 
cessful misston. For the purpose of this study, this value 
mas arbitrarily set at 70 feet. 

Table II presents a summary of data from the simula- 
tion runs illustrating bombing accuracy and the time response 
marameter If. Note that most of the lists of bombing ac- 
Beracics have a letter désignation at the top of the respec- 
Mmve columns. There. are referenced on Figures 24 and 25, 
where comparisons of the bombing accuracies are presented 
graphically. 

The inaccuracies resulting from those runs which start 
Blatt ycl  welesccuPouturcmitarcct are due to the fact that ‘the 
meretatt Cannot turn at a high enough rate to get on a bombing 


line passing near the target before it must drop the bomb. A 
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Illustration of Improvement in Bomb Impact Miss 


Figure 24. 
Distance for Varying Run Lengths. Initial y3 = 
20,000 ft. 
Original Program Results: Curves A,B 
Improved Program Results: Curves C,D 
Bomb Impact Miss Distance 
Vs. 
A x3 Simulation Run Length 
G 
B 
1000 ; 
G) No Bias Angle 
Z\ 3° Bias Angle 
meet. es 
7\ 
100 
P\ 
10 a 
() 
7 | ae 
- 10K = 2 ik eo O hc = 0K ao ih 
rec. 
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Figure 25. Illustration of Improvement 
in Bomb Impact Miss Distance 
for-Varying Run Lengths. 

10000 [namie 75-5000 ft. 
No bias angles. 


Bomb Impact Miss Distance 
vs. 
x3 Simulation Run Length 
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large part of the error improvement which can be seen in 
these two figures is due to the filter improvement. However, 
the controller also has a large effect on the overall re- 
sponse of the aircraft. The use of angle rate feedback helps 
terarive the lateral error to zero faster than in the origi- 
nal version. This is presented graphically ro Pig 2 02 NG te 
also that while the original version suffers the effect of a 
large overshoot past zero lateral error, the improved version 
does not. This is fundamentally the result of the rate feed- 
back acting as a damper. ; 

Examination of T in Table II whill show that the or- 
iginal simulation program achieved a lateral error below 70 
feet only once in the simulation trials run. The improved 
version reached the acceptable error 9 out of 15 times. In- 
Spection of the times will show that very little time is 
‘Tequired to achieve this figure of accuracy, including those 
mens which are initaalized with rather extreme initial error 
angles (e.g., 3, 8, and 9). Use of the new algorithms to 
estimate position and control the aircraft should result in 
a marked improvement in overall accuracy in bombing and in 


mec wonmwene tinal les required to achieve this accuracy. 


B. COARSE GUIDANCE PERFORMANCE 

NemeGintrasteing perrormance teses were pecrrorncd for the 
Coarse Guidance mode. The primary reason for this is the 
Pic onmecltinclone Drocram documencatron on the original ver- 


elon Of Coarse Guidance. Thus, the Coarse Guidance results 
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presented must stand on their own merit, on an absolute 
instead of a relative performance scale. 

As was the case for Precision Guidance, a large number 
of Coarse Guidance simulation runs were completed in the 
process of obtaining the final program version. A sample 
of some of the representative track plots with the RMS track 
deviations for those runs are presented Eee 27 through 
30. The significant aspects of each of these runs are 
discussed below. 

PiciMncae rep hesenus sa rather simple track to tollow; and 
is probably the most realistic track of the four presented. 
The turns to be executed and the initial heading and position 
E=Gors are not excessive. the control and turn logic caused 
mic aircrait to follow the desired path very closely. 

Seigtemscale Onrpg ss23 15 about half of Chat for Fig. 27 
ama thus the initial errors are more obvious. The track 
deviation figure is higher here than before due to the fact 
that the initial errors tend to take the aircraft away from 
mae desired track, vice in the track's general direction, 
Mmmwas che Casc for Fig. 27. Note that the control logic 
mas caused the aircraft to fly toward the second waypoint. 
At the appropriate time, the aircraft begins a command turn 
im order to be alignea properly on the second leg upon turn 
mempletion. the error from this point on 1S minimal, never 
Peceeding 0.28 NM on thie final leg. 

Evgume.Z9 ililustraeeés a most Unlikely track to be en- 


meneered in practice, but one whicn checks out the program 


So? 
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algorithms quite weli. The initial errors are as before. 
im this case, the aircraft exists from the first command 
furn only to note through turning logic that it is already a 
few seconds behind schedule to be able to make the correct 
turn onto the final leg. This is because of the combined 
condition of a relatively short leg length remaining and a 
requirement to execute 135° change in heading. It can be 
Been trom the plot that the aircraft was not able to come 
to the correct final leg heading of 225° from the command 
urn control alone. Another effect which is evident from 
BilS run is the lack of position update information in the 
filter during a command turn, due to poor radar return 
Simulation. 

Pregiinres S50 a5 the result of a track of the Same shape as 
miat used in Fig. 29, except the legs are twice as long. 
ihe initial position error is also the same as that for 
mre 2o9eobut the initial heading error from the desired 
rack in this case is 90°. The purpose of this track is to 
show that the program's algorithm can handle effectively a 
Mase such as that in Fig. 29, provided the given physical 
Memstraints of the system permit time to react. 

Note that the aircraft performs the correct course change 
and heads for the second waypoint, and from that point on 
me fearly coincident with the desired track. The relatively 
men track deviation figure for this run 1s due almost en- 
Meee y stOoetne cimfccts of the initial leading and position 


me1Yrors. 
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Each of these runs was made with a minimum error heading 


mor correction, H of 5°. Use of this number on runs 


ermin’ 
moar Which excessive initial errors were not present, i.e., 
Figs. 27 and 28, resulted in a command correction being sent 
less than 10 percent of the time during which command turns 

and initial error corrections were not in progress. This 
indicates a vast improvement towards the Toe of decreasing 

mie numbers of mid-course corrections being sent to the 

pilot during this phase of the problem. 

Autopilot control of the aircraft during this phase was 
assumed because it was not known how to realistically model 
miescttects of a pilot receiving an instruction to come to a 
mew heading. If pilot control of the aircraft is desired, 
the algorithms used provide a heading error which could be 
used. In fact, it is this value which is used to compute 
the bank angle correction. 

In summary, the improved Coarse Guidance algorithms ap- 
Mear to yield a greatly simplified and accurate technique 
mmecurding the aircraft onto the final leg. In addition, 
fe Errors in position and heading as the aircraft enters 
Mie final leg are such that the Precision Guidance filter 
mean be initialized with vaiid nonzero velocities, and thus’ 
the me Teacaned Oi the wid rec ecamebe reduced sven further, 
Since the requirement for a full six seconds without control 


could be reduced. 
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APPENDIX A: 


Erol sorry PRINCIPLE (VARIABLES FOR THE PRECISION 
AND COARSE GUIDANCE SIMULATION PROGRAMS 


PRECISION GUIDANCE MAIN ROUTINE 


Ai EE-ZIITLeE 


Bis 
BEE 

D 

DEG 
DT 
DTCON 
EM1 


EM2 
EM3 
EV1 
EIERES 


G 

HDE 
HDEDOT 
HA 

IB1 
EDT CON 
A 
IT 


IU 
KTH 


MWLD 


Titles of the plots 

Means of RADARO R, 8, and $ noise 
Bomb ballistics form factor 

Bomb diameter 

Radian/degree conversion factor 
Radar sampling interval 

Comenol Wedareuimeenyal: 


Matrix to convert from target to 
radar reference frame 


Matrix tO Convert wirom radar §to 
target frame 


Matwvix to rotate trom X%X5 to x6 
reference frame 


Translation matrix to go from 
PAreot tOrradarsreterence Frame 


Contains estimation error in 
radar frame for x,y,z, and radial 


Gravicatronalecoenstanitems2.2.2t/ secs 
Heading error angle 

Time derivative of HDE 

Height of target above sea level 
Equal to 0 in level bombing mode 
ineecer relacimgeD! sto. DLECON 

Copnter Lor TUnmber OL points to plot 


Equal to the number of times through 
main processing loop, except on last 
Piece LiirOuUch. when equal to -1 


Seed for random number generator, 
NORMAL 


Counter to indicate time for 
integration for RA wand TF calculations 


Number of "wild points" to be thrown 
out: by RADARS as anvalid 
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NWLD 
NTB 


PH 

PH1 
PHD 
PHD1 
PHD2 
PHDAVG 


PHB 
PHC 
PS 


Pow 


PSD 
RE 
RBT 


SIG(1) - SIG(3) 
SIG(4) - SIG(6) 
SIGW 


it 
Abs: 


TG 
ite 
TLVL 


TEvied 
VE 
VEH 

W 

WH 

WR 
ae 


Set equal to MWLD at time TWLD and 
decremented as "wild points" are used 


Number of bombing constant table to 
be used 


True bank angle 

Estimated bank angle 

Desired feedback command 

Desired feedback command from HDE 
Desired feedback command from HDEDOT 


Command to be ordered for last two 
seconds before bomb release 


Autopilot bias bank angle 
Command bank angle sent 


True aircraft heading angle in 
target frame 


Estimated aircraft heading angle in 
radar frame 


True aircraft turnime rete 
Radius of the Earth 


Distance from aircraft festimated) 
to the target 


Standard deviations of R, 6, and @ 
Initial radar velocity estimates 


Standard deviations of random forcing 
to be assumed for calculation of Q 


Mme etnntoO tae SIMU ation Tun 


Cel tit elit tolleresponse tine 
constant 


Time-to-Go to release bomb 
Limevor stall tom tne bomb 


Time for required level flight bcfore 
bponbs release canal to two scconds 


Povaleto. PoVie | 


otal atrcpece 

Horizontal alrspred 

Weight of bomb in pounds 
EStineucam mis itmetarget £cramc 
Estimated Wind in radar frame 


Truesvind in target frane 
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X1,XD1,XDD1 
2 2 
X52 xD 


X5,XD5 


X6 , XD6 


XE 
Mee 
Oe XC 


YYA-YYU 
GE 


' SUBROUTINE ARCRFT 
exe = CAS 


DT 


DEG 
DT3 


iTH 


IB1 
PH 
PHB 
PHC 
PHN 
PS 
PSD 
PSDN 


Estimated position, velocity and 
AeGeWeratiron. in Lradar —oramne 


True position and velocity in 
radar frame 


True position and velocity in 
target frame 


Estimated position and relative 
velocity of target with respect 
to the aircraft; "primed system" 


X5,XD5 system rotted to align 

the YD6 axis pointing at the 
target; for printing and plotting 
HUrpoOses, Chis Vector contains the 
error between true and estimated 
position in the X3/X5 frame 


Pace teal Cano. 
X bomb impact point in X6 frame 


Arrays used to store variables for 
plotting at program end 


Arrays used to store variables for 
plotting at program end 


Y bomb impact point in the X6 frame 


Constants used in al rerat ce. motion 
equations 


Radar sampling interval; also interval 
Se Update tor airerarte true position 


Radian/degree conversion factor 
Bata te tom) ly 2 
Gravitarronaleaceeleration, $2 £t/sec- 


Equals toOrnumnbetT times through loop, 
execepesonwlasGuemmeywhien ITH — —1 


Equals tomzenrouton, level flight mode 
True bank angle 

Bank angle bias 

Command bank angle 

New bank angle 

Heading angle 

Heading angle rate 


Now Wieai0 iit Simei ta Ge 
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PSN 
T 
TB 
TG 
VT 
WT 
X3 
XD3 


SUBROUTINES 


A 
ADDSUB 


ADUM 
ANGMAX 
ANGMIN 
BIS 
BDUM 


CA1,CA4,CAS 
CAA2 


DEG 
DT 
DTRAD 
DTCUM 


DT2 
DTRAD2 
DT3 

DT4 

E 
E1,E2,E3 


New heading angle 

Ebapsed time simee Start of run 

Th» the roll response time constant 
Time to go to release bomb 
Horizontal airspeed 

favieewineevec ton 

Aircraft position in target frame 


Alreratt velocity in tarset frame 


AND RADARS 


Azimuth angle 


SUDTOUEING wen Ery tO aad OT SUDETACEL 
two matrices 


Temporary array used in matrix 
arithmetic 


Maximum angle, used to prevent 
overflow 


Metin salle eused Stoo mre vent 
underflow 


Range, azimuth, and elevation noise 
bias 


Temporary array used for matrix 
arithmetic 


Constanes Sed simnealrecrart Motion 
equations 


Radian/degree conversion constant 
Radar sampling interval in RADAR9 
Radar sampling interval in RADARG 


Accumulator to determine next time 
to sample position in RADAR6 


Equaletomln-7 2 
Equal to DTRAD*/2 
Equa leoellhy, 2 
Equad non bill: 716 
Elevation angie 


Dittcrcneespetycen predietcd position 
and data sample during state estima- 
tion 


Gain Watras 


Or 





6G 
GAMMA 
GNX , GNY , GNZ 


A 

HT 
INVERT 
Pie 


IU 


NORMAL 


let 


PH1 
Pic 
PHI 


PHITRN 
PROD 


oe 


SiiGy aly S163) 
Scie Sma) 


SIGW 


TB 
TRANS 


Gravitational acceleration, 32 ft/sec? 
Tr matrix 


Give), G4 52), and G(723) terms of 
the gain matrix 


Measurement matrix 
Measurement matrix transposed 
SuUbrOutINe entity. LO Invert a matrix 


EGua bo UuNber One LImMes through 
Mali processing loop, Except on 
last time through when ITH = -l 


Seed for random number generator, 
NORMAL 


SUDTOULING fo generate normally 
distributed random variables to be 
used as noise 


Covariance of estimation error 
Miata 


Estimated bank angle 

Command bank angle 

StUdtee LhaSttbom Matrin used for 
gain generation only 

lranspose -of eh 


SUD POUL RICuCIIi@ny ston perromn the 
product of two matrices 


Estimated heading angle with respect 
to the wind 


Predicted new he@ding angle before 
AeCclerTatton es Cimate Correction 


EStimated turning rate 


Array resulting from expected random 
forcing assumption 


Range to target 
Contains random numbers from NORMAL 
Standard deviation for R, 9, and 4 


Initial velocity estimates for 
Peeadre fren 


Standard deviations of random forcing 
PM Piero miacear frame 

Roll response time constant, Th 

PUL woOumiomemtry slo periorm the 
transpose of an array 
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VT1 
VARR,VART , VARP 
WR 


X1,XD1,XDD1 

Ke MDZ 

X1P ,XD1P,XDD1P 
XDATA 


XIDENT 


COARSE GUIDANCE MAIN 
ATITLE-ETITLE 
AZ 


AZI 
BIS 
DEG 
DEL 


DT 
DTCON 
DTRAD 
DTG 
BES! 


ETRUE 
REET 


ea 
G2 
H 
HEA 
HTA 
HEG 


Estimate of horizontal airspeed 
Variances of R, 9, and $9 


Estimated wind vector in the radar 
frame 


Estimated state vector in radar 
frame (XDD1 not used in RADAR6) 


True state position and velocity 
in the radar frame 


Predicted state vector in radar 
frame 


Cartesian radar observation with 
noise 


Identity matrix 


ROUTINE 
Ttehes or plots 


Aytray £OT eStCOringwavetape lees 
azimuths 


Initial azimuth “tor tarst lee 
Array for RADAR6 noise biases 
Degree €0 radian conversion factor 


Initial displacement vector for true 
diEChatt pOsit Lon 


Ssetecanalete DICCN 

Comtrorupdatce anterval 

Radar sampling interval 

Distance trom Xi to Jes intersection 


EStimated direrare deviation from 
leg 


[Vie walTerittedevrlation from leg 


Feet-to-nautical mile conversion 
PaAGckor 


Ghavatatronal acceleration constant 
HDE gain constant, G, 
HBEDOT cain Constant , G. | 
Array of desired air headings 
Estimated aircraft air heading 
Troe aireratt air heading 


Estimated aircraft sround heading 
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HTG 
HDE 
HDEDOT 
HERMIN 


IDTRAD 
IEND 
ITH 


IU 
NLEG 
PHB 

PHC 

PHD 
PLENGTH 
RAD 
RMSEST 
RMSETR 
RANGE 


RANGEI 


emiGe ) S 1G (3) 
SiG SG (6) 


SIGW 


TB 
TAUH 
TINTRN 


THEA 
THETW 


True aircraft ground heading 
Heading angle error 
Heading angle error rate 


Minimum error angle for which 
commands will be sent 


Equal to the index on the current 
leg 


Integer relating DTCON and DTRAD 
Equal to 0 excep& on last leg 


Equal to the number of times through 
the main processing loop 


Seed for the random number generator 
Number of legs for the run 

Bias angle; assumed zero 

Command bank angle 

Desired bank angle from controller 
Length of each leg 

Radian to degree conversion factor 
RMS value ot EEST 

RMS value of ETRUE 


Array containing average range to 
each leg 


Range to start of first leg from the 
radar 


Standard deviations for R, 8, and 9 


Initial velocities for filter 
prediction 


Standard deviations for assumed ran- 
dom forcing; assumed zero for all 
BUNS eid tds Study 


Eimcatitoesinilbatton ruin 


ItvewatLeCho tia roll response time 
Eons tant 


Estimated aircraft roll response time 
constant; set equal to TB for all 
runs in this study 


Time into a command turn 
Array Gontaining azimuths of each leg 


Direcetmomucoward wiien tre wind blows 


RCS 





Note: 


THETWH Direction toward which estimated 
wind blows 

TLEG Array containing desired time to 
woven cacnie co 

TLEGI Estimated time remaining on a leg 

TSTOP Time at which problem ends 

Toler Time at which a zero bank command 
PSesellegto co MGerae elie 

TTOTTN Time at which a turn is completely 
over 

TG lIMer coe cO tO wean e a.) Lllnil 

VA True airspeed 

VAH Estimated airspeed 

VEG Estimated ground speed 

VTG True ground speed 

VW True wind speed 

VWH Estimated wind speed 

WR Equal to WH; components of estimated 
wind 

WT Components of true wind 

X1,XD1 Estimated aircraft position and 
VeloCiey 

X2,XD2 Desired track data; used for plotting 
only 

Ro xs True aircraft position and velocity 

XWP Array containing X waypoint co- 
ordinates 

XXA-XXE Arrays for use in plotting 

YYA-YYE Arrays for use in plotting 

YWP | Array containing y waypoint co- 
ordinates 

There are several variables with the suffix NM. These 


Vana kes TeGErespond tO tne Varrabple without the suffix, 
except the NM indicates the value stored is in nautical 


mikes. 


106 





APPENDIX B: 


CARD COLUMNS 


1 


1-10 
fre 7.0 
Zu 350 
31-40 
41-50 
ol O8 


10 
20 
20 50 
31-40 
41-50 
Slot 


iba ke 
= 2 
De 30 


L100 
i= 20 
ZA S0 


i100 
210 
21-30 


AO 
a0 
ees) 
31-40 
F150 
a 50 
61-63 


FORMAT 


F10.3 


—-z_=— 


Pad. 
is 


VARIABLE 


eel) 


107 


WT (2) 
WT (3) 
WH(1) 
WH (2) 
WH (3) 


BIS(1) 
BIS(2) 
BIS(3) 
SIG(4) 
SIG(5) 
SIG(6) 


SIG (1) 
SG) 
Ss1G(3) 


SIGW(1) 
CEG) 
SIGW(3) 


X3(1) 
X35 (2) 
X3(3) 


PHB 
TB 

DT 
DTCON 
EE 
TWLD 
MWLD 


PRECISION GUIDANCE INPUT DATA FORMAT DEFINITION 


REMARKS 


True wind in target frame 
x,y, and z directions ;WT(3) 
is usually zero 

Estimated wind in target 
frame;WH(3) is usually 

Zero 


Bias on range, azimuth 


and elevation noise 


Initial velocity estimates 


fOreesitey prediction 


Standard deviations on 
range, azimuth, and 


elevation noise 


Standard deviations of 
assumed random forcing in 


x,y,and z of radar frame 


itr aleposition (0,722) 
O£ alrcraft in target 


frame 


Autopilot bias angle 

Roll response time constant 
Radar sampling interval 
Control update interval 
Latitude of target 

ines co start wild pommes 


Number of wild points 





CARD COLUMNS 


8 


40-49 


50 


5 a 


i= 10 
= 20 
ZS 0 
31-40 
41-50 


5 = 00 


Hee 
ee Z.0 
Za 30 
31-40 
41-50 


—§1-53 


54-56 


1-48 


1-10 
20 
Za 50 
31-40 
41-50 
iS 


FORMAT 


FAO. S eS 
THNM 
THDM 
THD 
ATT 


ATH 


ANH 

TUP 

HTOL 

ATOL 

ar Oe. 5 S 
13 IBl 


13 TACC 


6A8 ATLILE= 


Dat ie 
FIO 2S WBLX 
WBLY 
BFF 
D 
Fal O. W 
les NTB 
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